float32[3] pos_ref      ## [m]
float32[3] pos_fdb      ## [m]